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METHODS AND APPARATUS FOR AUTOMATIC 
MAGNETIC COMPENSATION 

CROSS REFERENCE TO RELATED APPLICATIONS 

This application claims priority of Provisional Application Serial 
Number 60/436,980 filed December 30, 2002. 

BACKGROUND OF THE INVENTION 

This invention relates generally to determination of direction through 
magnetic direction indication, and more specifically to methods and apparatus for 
5 compensation of magnetic direction indications to account for local magnetic 
disturbances. 

Magnetic direction indicators (e.g., magnetic compasses, 
magnetometers) are typically compensated to account for local disturbances in an 
ambient magnetic field caused by nearby magnetic objects, for example, ferrous 
10 materials, and magnetic fields generated by electrical currents. Known compensation 
methods are both time consuming and expensive processes. These known 
compensation methods also provide a limited accuracy because the methods are 
typically optimized for only a single angle of magnetic inclination. 

Some known modem electronic compasses utilize soflware or 
firmware algorithms for magnetic compensation, but even these devices generally 
require time-consuming manual compensation procedures to determine a set of 
optimum compensation coefficients for utilization when performing the algorithms. 
Some low precision magnetometers are also known to exist, which provide quick 
automatic compensation techniques, but these techniques only provide a low accuracy 
compensation. Other known electronic compasses utilize biasing circuits as part of a 
closed loop system to attempt to reduce effects of magnetic field disturbances. 
However, these compasses also incorporate initialization modes, which can be 
complex, and which must be repeated upon each usage of the compass. 
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BRIEF SUMMARY OF THE INVENTION 

In one aspect, a method for characterizing distortions in the earth's 
magnetic field caused by a vehicle is provided. A magnetometer is affixed to the 
vehicle and the method comprises repeatedly measuring the distorted magnetic field 
utilizing the magnetometer and obtaining a three-dimensional orientation of the 
5 vehicle axes with respect to the earth at a time of each magnetometer measurement. 
The method also comprises receiving undistorted earth magnetic field data for the 
vicinity of the vehicle relative to the earth at the time of each magnetometer 
measurement and characterizing distortions caused by one or more of the vehicle and 
magnetometer errors utilizing the magnetic field measurements, the orientations of the 
10 vehicle, and the undistorted earth magnetic field data. 

In another aspect, a method of compensating a magnetometer affixed to 
a vehicle to obtain accurate magnetic heading information for a vehicle orientation is 
provided. The method comprises using the magnetometer to measure a distorted earth 
magnetic field relative to axes of the vehicle, determining a pitch and roll orientation 

15 of the vehicle axes with respect to the earth, and calculating the distortion of the 
earth's magnetic field for any relative angle between the vehicle axes and the earth's 
undistorted magnetic field. The method further comprises determining a magnetic 
heading based on the magnetometer measurement, adjusted by the pitch and roll 
orientation of the vehicle, and compensated for distortions of the earth's magnetic 

20 field. 

In yet another aspect, a method for determining a true earth magnetic 
field fi-om a magnetic field measured by a magnetometer is provided. The method 
comprises generating a truth reference field vector, h . , firom inertial data and a three 

dimensional map of the earth's magnetic field, determining a difference between a 
25 vector as measured by the magnetometer and the truth reference vector, and utilizing 
the difference to estimate corrections to magnetometer model coefficients. 



In still another aspect, a magnetic compass compensation unit for 
determining an orientation of a magnetometer within a vehicle relative to an 
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undisturbed magnetic field of the earth is provided. The compensation unit comprises 
a processor configured to receive measurements of the distorted magnetic field fi:-om a 
magnetometer, receive an orientation of the vehicle axes with respect to the earth at a 
time corresponding to each magnetometer measurement, receive undistorted earth 
5 magnetic field data for the vicinity of the vehicle relative to the earth at the time 
corresponding to each magnetometer measurement, and characterize the distortions 
utilizing the magnetic field measurements, the orientations of the vehicle, and the 
undistorted earth magnetic field data. 

In still yet another aspect, a processor programmed to generate a truth 
10 reference field vector, h- , fi*om inertial data and a three dimensional map of the earth's 
magnetic field is provided. The processor also determines a difference between a 
vector as measured by the magnetometer and the truth reference vector, and utilizes 
the difference to estimate corrections to magnetometer model coefficients. 

BRIEF DESCRIPTION OF THE DRAWINGS 

Figure 1 is an illustration of a magnetometer in a vehicle passing 
15 through, and disturbing, a magnetic field. 

Figure 2 is a detailed diagram of a magnetometer. 

Figure 3 is a flow diagram of a method for characterizing distortions in 
the earth's magnetic field caused by a vehicle. 

Figure 4 is a flow diagram of a method for compensating a 
20 magnetometer for local disturbances in the earth's magnetic field. 

Figure 5 depicts an overall structure of a magnetometer autocalibration 
and aiding process which utilizes Kalman filtering. 

Figure 6 illustrates magnetometer processing as three fimctions: a 
measurement residual calculation, a measurement matrix calculation, and a 
25 measurement covariance matrix calculation. 
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Figure 7 details the measurement residual calculation of Figure 6. 

Figure 8 details the measurement matrix calculation of Figure 6. 

Figure 9 illustrates a magnetometer process model. 

DETAILED DESCRIPTION OF THE INVENTION 

Methods and apparatus are herein described which automatically 
5 compensate a magnetic compass (e.g. a magnetometer) for local disturbances in the 
earth's magnetic field caused by a vehicle during normal vehicle operations. The 
methods and apparatus eliminate, or greatly reduce, time and expense associated with 
known methods for determination of magnetic compensation coefficients. Further, 
the methods and apparatus provide highly accurate, three dimensional compensation 
10 coefficients that are vaUd over all combinations of vehicle pitch, vehicle roll, vehicle 
heading, magnetic inclination, and magnetic declination. 

Figure 1 illustrates an vehicle 10 equipped with a magnetometer 12 
providing magnetic field strength signals 14. In one embodiment, magnetometer 12 
provides magnetic field strength signals 14 representing a measurement of the earth's 

15 magnetic field to a magnetic compass compensation unit 16, which may be part of an 
aircraft navigation system, for example. Magnetometer 12 includes three magnetic 
sensors (shown in Figure 2) placed in different orientations fi*om one another. In a 
specific embodiment, magnetic sensors are placed such that each sensor is linear with 
one of the three orthogonal axes of vehicle 10, Magnetic field lines 20 are shown a 

20 distance from vehicle 10, and are not disturbed by presence of vehicle 10. Magnetic 
field lines 22 however, are disturbed by the presence of vehicle 10. Magnetic field 
lines 20 and 22 are used to illustrate a presence of the earth's magnetic field. The 
disturbance to the earth's magnetic field is illustrated by the non-uniformities in 
magnetic field lines 22. The disturbed magnetic field passes through magnetometer 

25 12 which causes sensors to react, based on a magnetic field strength passing across 
each sensor. Therefore, magnetic field strength signals 14 are inaccurate because of 



-4- 



H0003756 



the presence of vehicle 10. In one embodiment, magnetometer 12 is a solid state 
magnetometer. 

As is known, magnetic field lines 20 and 22 are representative of 
magnetic field strength. Lines closer together represent a stronger magnetic field 
5 strength, and lines farther apart represent a weaker magnetic field. The Earth's 
magnetic fields originate from the earth's magnetic north and south poles, and for the 
most part are uniform. However, and as described above, ferrous materials or other 
magnetic field sources may interfere with or disturb the earth's magnetic field. Such a 
disturbance might well be represented by magnetic field lines 22 changing direction in 
10 the immediate vicinity of a disturbing source, i.e. vehicle 10. Trying to determine 
magnetic heading of vehicle 10 based upon magnetic fields disturbed by vehicle 10 is 
prone to error. 

Figure 2 is a detailed diagram of magnetometer 12. Magnetometer 12 
includes an x~axis magnetic sensor 30, a y-axis magnetic sensor 32, and a z-axis 

15 magnetic sensor 34 each in a respective orthogonal axis of vehicle 10. Sensors 30, 32, 
and 34 generate a signal based on strength of a magnetic field through which sensors 
30, 32, and 34 pass. Sensors 30, 32, and 34 are situated orthogonally, and the induced 
signal will be different for each axes, allowing determination of a three dimensional 
orientation of the disturbed magnetic field relative to orientation of vehicle 10. In one 

20 embodiment, magnetic sensors 30, 32, and 34 provide signals to an interface imit 36 
which modifies signals fi-om sensors 30, 32, and 34 for transmission to magnetic 
compensation unit 16 (shown in Figure 1). While sensors 30, 32, and 34 are shown 
and described as being orthogonal to one another, the methods and apparatus 
described herein are applicable to sensor configurations where at least three sensors 

25 are each oriented in a unique direction, not necessarily orthogonal and not necessarily 
along vehicle axes, which allow determination of compensation coefficients in a 
moving vehicle as further described below. Other embodiments exist where only two 
magnetic sensors are utilized. 

Figure 3 is a flow diagram 50 which illustrates a method performed by 
30 magnetic compass compensation unit 16 to characterize distortions in the earth's 
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magnetic field caused by vehicle 10. The method is utilized to detemiine an 
orientation of magnetometer 12 relative to an undisturbed magnetic field of the earth, 
where magnetometer 12 within a vehicle 10 which causes a disturbance to the 
magnetic field of the earth. Referring to flow diagram 50, the distorted magnetic field 
5 is repeatedly measured 52 utihzing magnetometer 12. A three-dimensional 
orientation of the vehicle axes is then obtained 54 with respect to the earth at a time of 
each magnetometer measurement. Undistorted earth magnetic field data for the 
vicinity of vehicle 10 relative to the earth at the time of each magnetometer 
measurement is received 56. Distortions caused by either or both of vehicle 10 and 
10 magnetometer errors are characterized 58 utihzing the magnetic field measurements, 
the orientations of the vehicle, and the undistorted earth magnetic field data. 

In one embodiment, signals 14 fi-om magnetometer 12 are calibrated by 
unit 16 according to hearth = Le * hmeas + hpe where, hearth is a three-dimensional vector 
for the undistorted Earth's magnetic field, hmeas is a three-dimensional vector for the 

15 distorted Earth's magnetic field as measured by magnetometer 12, Le is a three by 
three (3x3) matrix of magnetic correction coefficients, which includes, for example, 
nine correction coefficients, and hpe is a three-dimensional vector of magnetic 
correction coefficients which includes, for example, three correction coefficients. 
Signals 14 firom magnetometer 12, hmeas, are multiplied using a multiplication 

20 fimction by magnetic correction coefficients, referred to herein as Le which is the 
aforementioned three by three matrix of magnetic correction coefficients. The product 
of the niultiplication is added, using an addition function, to hpe, which is a three- 
dimensional vector of magnetic correction coefficients to provide a magnetic heading 
which is compensated for local disturbances to the magnetic field of the earth, for 

25 example, caused by the presence of a vehicle. 

Magnetic correction coefficients, or Le and hpe, are estimated by 
comparing the three-dimensional magnetic field strength matrix, hmeas, as measured by 
magnetometer 12, against a three-dimensional magnetic truth system (not shown). A 
magnetic truth system provides an independent means to determine orientation of the 
30 Earth's undisturbed magnetic field relative to the orientation of magnetometer 12. 
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The undisturbed Earth's magnetic field for a location can be determined from a 
geographic map of magnetic inclinations and declinations, assuming vehicle position 
is known through GPS or other means. Pitch and roll orientations of vehicle 10 can 
be determined by an attitude heading reference system (AHRS). Other sources of 
5 pitch and roll signals include, but are not limited to, an attitude reference system, an 
inertial reference system, and an inertial reference unit. The true heading orientation 
of vehicle 10 is provided through utilization of one of at least four different methods, 
and then transforming undistorted magnetic field components to distorted magnetic 
field components over relative orientations between the undistorted magnetic field and 
10 one or more of the axes of vehicle 10 and the axes of magnetometer 12. 

One method for determining true heading involves a vehicle equipped 
with GPS. GPS is utilized to determine a true heading while the vehicle is moving by 
assuming tme heading equals GPS track angle. The method assumes the vehicle's 
wheels are aligned with a longitudinal axis of the vehicle and that the vehicle is not 
15 turning or side slipping. However, effects of tums during movement are easily 
compensated by knowing the geometry of, for example, aircraft landing gears and by 
measuring GPS velocities and/or the yaw rate as determined by aircraft gyroscopes. 

A second method for determining true heading involves a vehicle 
equipped with GPS and an Attitude and Heading Reference System (AHRS). Well- 
20 known AHRS algorithms are utilized to calculate a true heading while the vehicle is 
experiencing horizontal accelerations, including centrifugal accelerations caused by 
tums. These AHRS algorithms can continue to determine a true heading for a limited 
time dvu"ation after the acceleration stops, on the order of minutes. 

If the vehicle has an Inertial Reference System (IRS), then a third 
25 method for determining tme heading involves use of a tme heading signal received 
directly from the IRS. An altemative is a synthesized magnetic heading signal from 
the IRS. A fourth method for determining tme heading is utilization of a dual antenna 
GPS, from which true heading can be directly calculated. 
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Twelve coefficients, including nine magnetic correction coefficients 
and three vector of magnetic correction coefficients, are calculated using several 
methods. A preferred embodiment is to populate a three-dimensional magnetic error 
table with data during normal aircraft operations. The magnetic error table, in one 
5 embodiment, maintains separate data points for multiple orientations of the earth's 
actual magnetic field with respect to vehicle pitch, roll, and yaw axes. For example, 
the magnetic error table may include separate data points at 30 degree increments in 
yaw and at 60 degree increments in pitch and roll. In such an embodiment, the 
magnetic error table is configured with 216 data points. Each data point is a three- 

10 dimensional vector of magnetic error relative to the vehicle axes. Therefore, magnetic 
error table includes 648 scalar values. The data at each data point, in one 
embodiment, is low pass filtered, with a time constant of several hours. The low pass 
filtering occurs during a period when the orientation of the actual magnetic field 
relative to the orientation of vehicle 10 corresponds to the three-dimensional vector as 

15 represented by one of data points. Data points are not updated when the magnetic 
field present at vehicle 10 does not correspond to a particular data point. 

Several, but perhaps not all, of the data points in magnetic error table 
will be updated during each flight, depending on, for example, how many turns 
vehicle 10 makes, vehicle orientation, and the angles of inclination it flies through. 
20 After a number of flights, the twelve compensation coefficients are determined fi:om 
the highly overdetermined 648 scalar values of the 216 data points, through well- 
known mathematical procedures, for example, utilizing a least squares determination. 

In conjimction with the above, a method for compensating a 
magnetometer affixed to a vehicle is illustrated in flowchart 60 of Figure 4. The 

25 method provides accurate magnetic heading information for a vehicle orientation. 
Referring to flowchart 60, a magnetometer 12 (shown in Figure 1) is used 62 to 
measure a distorted earth magnetic field relative to axes of vehicle 10 (shown in 
Figure 1), and a pitch and roll orientation of the axes of vehicle 10 is determined 64 
with respect to the earth. A distortion of the earth's magnetic field for any relative 

30 angle between the vehicle axes and the earth's undistorted magnetic field is calculated 
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66 and a magnetic heading based on the magnetometer measurement, adjusted by the 
pitch and roll orientation of vehicle 10, and compensated for distortions of the earth's 
magnetic field is determined 68. 

In a further embodiment, a Kalman filter model is developed to carry 
5 out the above described procedures, and which automatically calibrates the twelve 
parameters that make up the three dimensional magnetometer model for estimating the 
true earth's magnetic field from the field measured by magnetometer 12. This 
calibration method uses pitch, roll, heading, and position data from one or more of a 
GPS, AHRS, inertial reference system, inertial navigation system and ground based 

10 navigational aids (i.e., VOR, distance measuring equipment (DME)), along with a 
three dimensional map of the earth's magnetic field to generate the "truth" reference 
field vector. The difference between the magnetometer-measured field vector and the 
"truth" reference vector becomes the measurement for the Kalman filter. The Kalman 
filter then estimates corrections to the magnetometer model coefficients as well as 

15 corrections to the attitude and heading angles of the navigation system. 

Figure 5 depicts an overall structure 100 of the above described 
magnetometer auto-calibration and compensation process. Magnetometer 102 
measures the earth's magnetic field and provides the measurements to a magnetometer 
measurement process 104. A GPS receiver 106 provides GPS measurements to a GPS 

20 measurement process 108. Although GPS receiver 106 is the only aiding source 
depicted in Figure 4 besides magnetometer 102, other aiding sources may be utilized 
as well, such as barometeric altitude, airspeed, and other sources as previously 
described. Outputs from magnetometer measurement process 104 and GPS 
measurement process 108 are combined utilizing measurement model 110, whose 

25 outputs are input to Kalman filter 112. 

Kalman filter 112 provides a filter state output 114 which is provided 
as an input to magnetometer measurement process 104 and GPS measurement process 
108 as well as to navigation solution generator 116, which provides, in the 
embodiment shown, an aided navigation solution 118. Inertial sensors 120 also 
30 provide data to navigation solution generator 116. The aided navigation solution 118 
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is fed back as inputs to magnetometer measurement process 104 and GPS 
measurement process 108 as well as to a GPS/inertial process model 122 and a 
magnetometer process model 124. Outputs of GPS/inertial process model 122 and 
magnetometer process model 124 are input to a process model 126, whose output is 
5 input to Kalman filter 112. 

In developing the Kalman filter model, a model of the field as 
measured by magnetometer 12 is utilized. Specifically, the field measured by the 
magnetometer is related to the true earth's field h according to: 

h„=Mh + h^ (1) 

1 0 where 

M = 3x3 magnetic permeability matrix 

= 3x1 vector of field offset errors resulting from perm2inent magnetization 

A tilde (~) is utilized to distinguish the magnetic field vectors from the 
Kalman filter measurement vector h which is described below. 

15 By solving for h the true field from the measured field is computed via 

where the matrix L is defined as L = M"^ . Comparing equation (2) 
above with the calibration equation from the first embodiment, (i.e. heanh = Le * hmeas 
+ hpe), it is seen that the two equations are equivalent if Le= L and hpe= -Lh^. To 

20 develop the Kalman filter, it is assumed that the initial value of matrix L is equal to 
the identity matrix, and that the initial vector of field offset errors, , is zero. 
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A linearized error equation for the magnetometer-measured and 
compensated body-axis earth's field components is obtained by taking partial 
differentials of equation (2). For example. 



(3) 



= JLAh-L<5il^ 

5 where Ah is defined as 

Ah = h„-h„. 

m p 

Equation (3) provides a basic estimate of errors in a matrix format and 
is broken into three separate measurement equations (one for each field component), 
where each equation is in the form of a row (measurement mapping) vector multiplied 
10 by a column vector of magnetometer parameter errors to provide scalars that are 
functions of the vectors, for example, 

Sh^^Ah'Sl,-\l,Sh^ (4) 

Sh^=Ah'Sl,-\l,Sh^ (5) 

Sh^=Ah'Sl,-\l,Sh^ (6) 
15 where 

= thei* row of^L 
I^. = thei* row of L 

Altematively, each term is written as a matrix times an error vector by 
defining the following 9x1 error vector 

Sl= SI, (7) 
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Then, equation (3) can be re-written as 





0u3 


0u3 






0 


0,,3 


0u3 


Ah' 



<5I-L(5h. 



(8) 



which provides magnetometer errors. 

To compute a GPS/AHRS-based or inertial navigation system-based 
"truth" field h. , the earth's field vector is first determined in north/east/down fi-ame 

components based on the current latitude, longitude, altitude, and (perhaps) time 
using an accurate model or map. Next the earth's field vector is transformed into body 
coordinates, to find errors in the "truth" source via the following transformations: 



(9) 



where Cf transforms a vector fi-om the local-level firame (L-fi-ame) to 
the body fi-ame (B-fi:ame) and is the transpose of the attitude direction cosine matrix 
C, and accounts for the rotation in azimuth of the local-level firame with respect to 
north by the wander angle a and is given by 



cos a sin a 0 
-sin a cos a 0 
0 0 1 



By taking partial differentials of equation (9), 



Sh, = JC^C^h^ +C^^C^h^ +C^C^,<5h^ 



(10) 



where y is the attitude error vector which represents the angular error 

of the L-frame relative to the B-fi-ame, £ the angular position error vector which 
represents the angular error of the L-frame relative to the earth frame (E-frame), and 
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{v} represents the skew-symmetric matrix form of the enclosed vector v and is 
defined by 



0 -V, 



0 -V 

X 

V. 0 



(11) 



During the GPS-aided mode, the "psi-angle" inertial error model is 
implemented in the Kalman filter, shown below. In such an embodiment, the attitude 
error states are actually the three components of the angular error vector \|/ defined as 



(12) 



Using this substitution in equation (10), the first two terms combine to 
give yield following 



Jh, = C {\|/} C^h^ + CC^^h"^ 



(13) 



To express each term in equation (13) as a matrix times an error vector, 
the first term must be re-arranged. The product of a skew-symmetric matrix form of a 
vector v multiplied by a vector u is the same as the cross product v x u. By reversing 
the order of the cross-product, the sign is reversed. Therefore, 

{v}C^h^ = Vx(c^h'') = -(C^h^)xv = -{c^h^}v (14) 



and equation (13) is rewritten as 



. = {C^h^ } \|/ + CC^^dh'' 



(15) 



The measurements to the Kalman filter are the differences between 
each of the magnetometer-derived earth's field components and the respective 
GPS/AHRS-derived earth's field components. These measurements can be processed 
one at a time or all at once. Each measurement equation is in the form of 
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^k=K^k'^^k (16) 

Where h^^ is the measurement mapping vector at time t^^ , is the 
state vector, and is white (uncorrelated) measurement noise. If all are processed at 
once, the measurement equation takes the form of 

Za=Ha+v, (17) 

where is a 3x1 vector of measurements at time t^, is a 3xn 
measurement matrix, and v^^ is the measurement noise vector. 

By assuming that the three "psi-angle" attitude errors make up first 
three states and the twelve magnetometer parameters and the three earth field 
modeling errors make up the last fifteen states. The state vector is then written as 

= |^\|/^ . , . other nav/sensor states ... SV dh^ (^h^^ )^ j (18) 

The measurement vector is determined subtracting equation (15) firom 
equation (8) and adding measurement noise 



z = h - h; = Sh-Sh; + v 

(19) 



Ah' 0,,3 0,^3 
Ah^ 0 
0,.3 0,^3 Ah^ 



51 - L^h^ + C"" {C^h^ } If/ - CC^^^h^ + V 



where v represents a vector of uncorrelated measurement noise due to 
electromagnetic noise and random earth field modeling errors such as quantization. 

From equations (17), (18), and (19) it is shown that the measurement 
mapping matrix H is 

H = [h^ 0 - 0 H„ H^^ H-,] (20) 
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where 

Ha 

hp 

Barring any disturbance (such as Ughtning strikes), the magnetometer 
parameters are assumed to be very stable over time, therefore a reasonable model to 
describe random processes for each of these states is a Gauss-Markov process with a 
very long correlation time, in one embodiment, about 1000 hours. A reasonable one- 
sigma value for each of the nine SL. states is approximately 0.15 (15%), which 
corresponds to an angular error uncertainty of about 8.5"^. A reasonable one-sigma 
value for each of the three offset errors contained in the vector Sh^ is 75 mgauss. 
Assuming an earth's field of 500 mgauss, this would again correspond to an angular 
error of about 8.5°. (The earth's field intensity ranges from about 250-650 mgauss). 
If a major disturbance does occur, it would be rather abrupt and would certainly be 
detected by standard Kalman filter residual screening. 

A first-order Gauss-Markov process x is defined by the following 

1 /2o-' , , 

x = u(t) (21) 

r V r 

where u(t) is unity white noise. The discrete-time model of this 
process is given by 

=^kXk+^k (22) 
where 







0,.3 0..3 






Ah"^ 0 






Ou3 Ah^ 




-L 
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-7/ 

= Gaussian white noise sequence with variance = cr^ |l -e j 

CT = Steady-State one-sigma value of the process 

T = correlation time of the process 

T = the discrete time interval between t,^ and t^^., 

The earth field modeling errors will vary as a function of position 
rather than time. Therefore, a Gauss-Markov process model which varies over 
distance traveled would be appropriate as such a model defines how state vectors vary 
5 over time. According to the National Geophysical Data Center (NGDC), local 
anomalies in geomagnetism which deviate from the Intemational Geomagnetic 
Reference Field (IGRF) can exceed 10° of inclination and/or declination, hi fact, 
Minnesota contains an extreme declination anomaly of 16"^ east in one area and 12° 
west just a few miles away — a change of 28 degrees. Over most of the world, 

10 however, the IRGF model is good to 0.5°. A reasonable one-sigma value to use to 
bound these larger anomalies might be 50 mgauss (corresponding to a 5.7 degree 
angular error for a 500 mgauss field) with a correlation distance of 10 nautical miles. 
Thus when cruising at 500 knots, the effective correlation time would be 72 seconds. 
However, during final approach at 150 knots an effective correlation time would be 

1 5 about four minutes. 

The one-sigma measurement noise for the magnetometer is assxmied to 
be on the order of 0.5 mgauss for each component which corresponds to an angular 
error of 0.06° for a 500 mgauss field. 

The GPS/inertial process models are augmented by the fifteen process 
20 models associated with the magnetometer states to form the overall process model in 
matrix form 

X,., =^,x,+w, (23) 
where 
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= state transition matrix = the undriven response over time t,^to t^+, 
Wj^ = process noise vector = driven response to the white noise input over time t,^to t 

The magnetometer measurements may be processed independently or 
along with other aiding measurements such as GPS by augmenting the measurement 
vector z with these three additional measurements. Likewise, the measurement matrix 
H would also be augmented with these three additional rows. Standard Kalman filter 
time propagation and measurement update equations are iterated using known 
methods. For example, the estimated state vector x^^ and its associated error noise 

covariance matrix are projected forward to the next time step as follows 



and the estimated state vector and the error covariance matrix are 
updated for the new measurement vector according to 



(24) 



p;..=^*n«»I+Q* (25) 



where 



x^^i = estimated error state vector prior to the measurement update at time t,^^., 

= £'[x^x[] = error covariance matrix after the measurement update at time 1,^ 
Qjt - ^'j^w^Wj J = process noise covariance matrix over time t^to t^+, 
P^"^, = the error covariance matrix prior to the measvirement update at time t^+, 




(26) 




(27) 



p,=(i-K,H,)p; 



(28) 
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where 

Rj^ = £'^Vj^v[ J = measurement noise co variance matrix at time t^ . 

Figure 6 is a detailed illustration of one embodiment of magnetometer 
measurement process 104, which includes three functions, a measurement residual 
5 calculation 140, a measurement matrix calculation 142, and a measurement 
covariance matrix calculation 144. To calculate measurement residuals, measurement 
residual calculation 140 receives as inputs, measured earth's magnetic field as 
measured by magnetometer 102 (shown in Figure 5), filter state output 114 from 
Kalman filter 112 (shown in Figure 5) and aided navigation solution 118 (also shown 
10 in Figure 5). Measurement matrix calculation 142 utilizes results of residual 
calculations made in residual calculation 140 to provide a magnetic field matrix 
output 146. Measurement covariance matrix calculation 144 is based on an identity 
matrix 148. 

Figure 7 illustrates measurement residual calculation 140 (also shown 
15 in Figure 6). Measured earth magnetic field 160 is first compensated using the current 
estimates of Sh^ 162 and L 164, an inverse of the permeability matrix M, Note that a 

nominal value for L 164 is assumed to be identity matrix 166. The matrix 168 is 
an estimate of the error from this nominal identity matrix 166 and an estimate of the 
errors from magnetometer 12, SL, , are subtracted from it to yield a current estimate of 

20 L 164. The magnetic "truth" field 170 (an inertial model of the earth's field) is 
computed from current estimates of altitude 172, position 174, and current date and 
time 176 using earth's field model 178 and current earth-to-local-level frame and 
local-level-to-body frame transformations 180 and is corrected for the earth field 
modeling error estimate Sh^ 182. Since the measured field vector 184 and truth 

25 reference vector 186 are corrected explicitly (and the attitude error is reset in the 
strapdown navigation equations) with the state vector estimate from the filter, the 
difference between the two corrected field vectors 184 and 186 becomes the 

measurement residual vector 188 (z^ -H^x^ ) of equation (27). 
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Figure 8 illustrates measurement matrix calculation 142 which 
provides a solution of equation (20), which is described above. Current date and time 
176 is input as are local level transformations 180 and a modeled earth magnetic field 
178. Also input to measurement matrix calculation 142 are earth field modeling error 
5 estimate ^h^ 182 and L 164, an inverse of the permeability matrix M. An output of 
measurement matrix calculation 142 is the measurement mapping matrix H. 

Figure 9 shows a magnetometer process model 200 which results in 
calculation of , the state transition matrix described with respect to equation (23) 

above, and Qj^ the process noise covariance matrix over time, as described with 
10 respect to equation (25), for the magnetometer states. 

Once the twelve compensation components are determined, either 
through Kalman filtering, or through population of the magnetic error table, unit 16 is 
configured to remove local disturbances to the earth's magnetic field. Once the local 
disturbances are removed, accurate navigation of an aircraft or other vehicle is 
15 attained since the magnetic heading information supplied to the pilot is a true 
magnetic heading, imcompromised by local magnetic disturbances. 

The above described methods and apparatus illustrate how 
magnetometer readings can be automatically compensated to remove local 
disturbances in the earth's magnetic field based upon data received fi-om, for example, 
20 an inertial navigation system. While the invention has been described in terms of 
various specific embodiments, those skilled in the art will recognize that the invention 
can be practiced with modification within the spirit and scope of the claims. 
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